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Experimental setup implements the concept of degree of observability (DoO) 
adequate a land-vehicle navigation application with noised inertial 
measurement unit (IMU) and global positioning system (GPS) sensors based 
on a loosely coupled approach. The navigation systems such as IMU-GPS 
require extensive evaluations of nonlinear equations as used in an extended 
Kalman filter (EKF). According to DoO and during our test, we have 
implemented a method for measuring the DoO of all states continuously. 
Where, the results showed that applying the fusion IMU-GPS system based 
on EKF be enhanced the DoO measure. The real dataset consists of outputs a 
high sampling rate for IMU sensor at each (0.01s) and GPS receiver at each 
(1s). In addition, an aloft category IMU was put together with differential GPS 
(DGPS) information to produce a real trajectory. GPS has acceptable long- 
term accuracy, it is used to update the position and velocity in IMU outputs 
before processing in the EKF algorithm. The implementation consists of three 
main algorithms: Strapdown (dead reckoning DR), DoO and EKF algorithms. 
The results are shown, implementation of both approaches based on EKF and 
the concept of DoO in GPS/INS integrated systems are sufficient robustness 
to use with low-cost sensors. 
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1. INTRODUCTION 


An inertial navigation system (INS) is an independent navigation system even in the absence exterior 
data [1], [2]. Where, its contributed this capability that to the emergence of many research and industrial 
development [3], [4]. Inertial measurement unit IMU)s low-cost systems have become in along time-proven 
a principal part of vehicle navigation systems [5], [6]. However, the reliability of an INS is less perfect over 
time by accumulation errors [7]. Error model application in the INS-GPS navigation system was given in [3]. 
In addition, The error model is obtained by employing a first-order model of the IMU. On the other hand, a 
complex INS error model with a Kalman filter of 54 states was presented [8], [9]. 

Global navigation satellites system (GNSS) as satellite technology is continuously developed and 
widely used in many areas of human life such as vehicles or aircraft (e.g. aerial robots) [10]. GNSS satellite 
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technology permits the operator to define the location of the aircraft and land-vehicle by using absolute and 

differential methods [11]. In addition, there are presentations of the DGPS (differential GPS) method in [12]. 

In the DGPS technique, ground stations in connection to the mobile onboard GPS receiver mounted in the 

aircraft plays a key role [13]. Moreover, the number of GNSS reference stations involved in DGPS positioning 

is also very important [14]. 

INS-GPS integration idea is to use both methods of localization together: estimate and absolute. This 
idea is justified by the complementarity of proprioceptive sensors and exteroceptive sensors [15]. Integration 
system ameliorates the quality and integrity of the navigation system, and INS able be utilized to ameliorate 
the pursuit when GPS signal outage [16]. For INS-GPS integrated system error estimation and compensation. 

Estimating techniques such as EKF are frequently utilized. Based on an INS error model and GPS 
updates, KF calculates location, speed and pitch errors [8], [17]. Therefore, applying this method requires an 
error model for the INS and a measurement model for the GPS. Since GPS has acceptable long-term accuracy, 
it is used to update the position and velocity given by the INS. Thus, it limits the long-term increase of INS 
errors. On the other hand, the short-term, precise information provided by the INS is used to overcome GPS 
outages and multipath errors. Kalman filter operates in the prediction model when GPS outage occurs and the 
error model is used to rectify the INS data. 

To preserve the navigational signals seen between satellite and its receiver, many guidelines have been 
set to specify the GPS raw data format. The national marine electronics association (NMEA), the radio 
technical commission for maritime services (RTCM) and the transceiver independent exchange format are the 
most widely utilized standards (RINEX) [18]. 

Concept of the DoO with respect to INS-GPS integrated systems is investigated in this work. in view 
of the fact that traditional observability analysis is inadequate for an extraordinary navigation scenarios matrix 
that becomes very large for high-order time-variant system, such that it rises computational difficulties. Since, 
an unobservable system would not yield an accurate estimation [19] and is prone to divergence [20]. However, 
if the level of noise is insignificant as a result, observability sets a lower limit on the estimation error, and for 
more information, see [21]. Therefore, and based on the above discussion, the paper objectives are: 

a. Experiment low-cost IMU system to be used as autonomous navigation systems during long GPS outages 
for general land-vehicle navigation. Then, the fusion of IMU and GPS sensors is assured by the proposed 
EKF that is used as an estimator technique. 

b. Apply a practical approach for observability, especially in dynamic analysis systems, which define the KF 
efficiency in the estimated states. 

The following is a breakdown of the paper's structure: section 2 demonstrates the methodology that 
was employed. Sections 3 and 4 show summaries of our testing as well as explanations of the results. Finally, 
in section 5, the conclusions are provided. 


2. RESEARCH METHOD 
2.1. INS-GPS integration methods 

Different INS-GPS coupling modes exist in the literature [22], [23]. Besides that, difficult problem to 
develop in real-time for navigation system design [6], [24]. The navigation system in our method consists of a 
civilian GPS receiver and a low-cost inertial sensor that are loosely connected as shown in Figure 1. This 
method allows for cost savings in both design and implementation [24], [25]. 
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Figure 1. Direct configuration 


The GPS receiver's role is to keep the INS up to date with current positions and speeds. The difference 
between positions and velocities of the both outputs GPS and IMU sensors compute the residual error for input 
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of KF algorithm. The loosely coupled form has various configurations and implementations. The most noted 

are implementations the open-loop operation and the second closed-loop [7], [26]. In addition, the above INS- 

GPS integration methods are based by: 

a. INS algorithm for integration process. Kalman filter form [26] is defined by two inputs factors, INS 
calculation equations and INS error model. 

b. INS mechanization equations, an IMU was placed on the vehicle's roof. As a result, the both of specific 
force and the angular velocity in the body frame are defined by f? and w%,. Latitude 6, longitude à and 
height h are used to describe the vehicle's location. In the navigation frame, the equation is as: 

p v” 

oN | = |REf” — (wie + Wen)v™ + g” (1) 

Ri Rp (25 a: Qin 


Where: p: position vector in the navigation frame, p = [¢, A, h]? 
Rp: transformation matrix from the body frame to navigation frame 
wis: earth rotation rate vector expressed in the navigation frame 
Wen: Orientation rate vector of the navigation frame 
N? : skew-symmetric matrix of the body rotation rate 
NĚ: skew-symmetric matrix of the rotation rate vector 
w?,: rate of earth rotation expressed in the body frame 
g”: gravity vector expressed in the navigation frame 
v": velocity vector in the navigation frame, v" = [vp, Ve, Va] 


2.2. INS error model 
Generally, Information use in the INS-GPS system is preferred to represent in the context of the local 
geographical location [3], [7]. The placement p = [¢, A, h]" is generated by integration of (2) [7] 


; itn. 
p Ryth 
p = d = Ve (2) 
h cos(o)(Ry+h) 
va 


Where Ry and Ry are the meridian and normal earth radii, respectively. 

Numerous types of errors affect several navigation systems. Initial condition faults, nonorthogonal 
features of gyro-meters and accelerometers, and mistakes throughout the integration process all affect INS 
[27], [28]. However, skew, scale factor error, non-orthogonality, and random errors are the most common 
defects [7], [27] are presented in the inertial sensors (gyro-meters and accelerometers). The common 
representations of errors are: 


Af? = f> — fP (3) 
Awi = Why — Wir (4) 


Where: f and w?, are the measured values, correspondingly of f’ and wf, 

Af? Aw?, represent measurement errors in specific force and relative angular rate. 

Af” and Aw, are the specified force error and related angular velocity error estimates, respectively. 
The favorite notion of error statuses (6x) in a navigation system is convenient [26]. 


op 


op b 
5 
60" | =F |óv| +G Al (5) 
p p OWib 
Fp pv Fpp 0 0 
With F = | Fp Fw Fop |andG =|-R} 0 (6) 
n 
Fop Fov Fpp 0 Rp 
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The error vector has been established by 6x = [őp, őv, p]", where dp = p — p = dp = [6¢, 6A, bh], 
bv = vi — D? = Sp = [6v , 6Ve, dVq]" p = [En, Eg, Ep] and ôwg, = Aw, + Awh.. 


Many forms of matrix F are proposed [29]. In [8], it contains of the proposition of a simplified error model. 
The constituents of matrix F in this scenario are as: 


0 0 0 
Fp=|0 0 o| (7) 
0 0 0 
1 0 0 
Fx =]|0 1 o| (8) 
0 0 1 
0 0 0 
Fp = }0 0 | (9) 
0 0 0 
0 0 0 
Fp =|9 0 0 | (10) 
0 0 7;? 
0 —2Wie Sin p 0 
Ep = 2m, sing 0 2Wie COS Q (11) 
0 —2Wie COS Q 0 
0 fot29 -fn 
Fop = |- fo — 29 0 fe (12) 
fn -fe 0 
0 0 0 
Fop = fo 0 o| (13) 
0 0 0 
0 Rz! 0 
Fv =|-Rz! 0 ol, (14) 
0 0 0 
0 —Wie SiN Q 0 
Fop = |Wie sin o 0 Wie COS P (15) 
0 —Wie COS Q 0 


Where: ø is the latitude and Tp ~ E = 520(s) 


Re = RyRy ~ 6372795.5 mis the earth average radius. 
Wie © 7.292115 x 10-5rad_/s is the earth rotation rate. 
fi. fe» fp: are the specialized forces of north, east, and downward. 


2.3. Extended Kalman filter 

INS-GPS in direct configuration, the KF is made up of two estimated values combined (INS and GPS 
data), the position, velocity, and attitude (PVA) solutions are the same for these two parameters [27], [26]. In 
our experiment, the inertial navigation system, which serves as the process model, provides the initial estimate 
directly. The GPS receiver provides the second estimate, which is the measurement. The position of the system 
(land-vehicle) in a navigation system is represented by state, speed, and attitude (PVA solutions) [26]. In a 
continuous state, the moving system is characterized by linear system equations [8]. 


X(t) = F(t)x(t) + G(t)u(t) (16) 
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The dynamic matrix (obtained via partial derivatives) is F(t), the position vector is x(t), the layout matrix is 
G(t), and the forcing function is u(t). The components of of u(t) = [8f?, wb, ]T are white noise with a 
covariance matrix of 


2 


=e 2 72 72 72 2 
Q = diag (03,03 03,0518 py Cee (17) 


The following is the measurement model: 

z(t) = H(t)x(t) + v(t) (18) 
Here z(t) is the measurement at time t, H denotes the observation matrix and v(t) denotes white noise 
v(t) ~N (0,R). The use of IMU data should be based on very short sampling time intervals At = tk — ty_1 


(update every IMU=100 Hz), Table 1 shows the position (vehicle movement: PVA variation scalar) and 
measurement model [7], [27]. The discrete-time KF equations are summarized in Table 1 [3], [8]. 


Table 1. KF equations in discrete time 


KF parameters KF equations 
System model Xg = Py Xp_-1 + We_1, Wg ~N CO, Qk) 
Initialization 25 = E[xo],P5 = var (x5) 

Gain calculation K, = Py HË (Rẹ + Hy, Pe HE) 
Measurement update RE = 2o + Ky Hye — Fu) 
Covariance matrix update Pè = [I — K, Ay | Pe 

Time propagation Kiar = OX + Gkuk 


Pray = PPE Pe + Pax 

(Pax = G,.®,GEAT) 

Where x7, x*: are, respectively, the Priori and Posteriori state vector, 
P~,P*: are, respectively, the Priori and Posteriori error covariance matrix. 


0 0 
G=|-RE 0| and Q = diag(o2,, 02y, 02, 2x Tey, o2z) 
0 Ri 


are, respectively, the standard deviation of the accelerometers and gyro-meters 


2.4. Observability analysis 

A method that allows knowing the degree the health of internal system if it's good or no by measuring 
the external information output detects. This method is called 'observability' [30]. Here, in our non-linear 
system, H(t)=I3x3 is time constants; thus, we put observability by using Boolean condition. 


rank(0,) 2 rank (0,41) (19) 
No(t PO wh Ae 
a 
let 0 = N0 Ho (t) F(t) t ax Ho (t) as HF (20) 


Ny-1(t) Ha OFO + 2Hy (0 BE 


However, in [31], the innovation of the idea of "degree of observability" was based on a quantitative 
approach. We achieve an error covariance (P), through the several iterations in the extended Kalman filter 
process. The disparity between the estimate and real state values is indicated by this error. Furthermore, the 
standard mathematical analysis has been applied. 

Description normalized error (P’) 


P'(k) = (VP) P(k) (\P@) (21) 


Where: P(O) is the initial error covariance matrix, P(k) is the current error covariance matrix. The acquired 
matrix can be presented in (22), Pij and Pij(0) are the error covariance matrix elements. The pursuit is obtained 
by the sum of all of the eigenvalues, after that we obtain the normalized error covariance in (8). The eigenvalues 
of P"(k) are without dimension and limited between 0 < Ai < n, such that the DoO is defined better, as the error 
turns smaller. 
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P11 P12 P12 
P41(0) V¥P11(0)P22(0) "J P44(0)Pnn (0) 
P21 P11 P12 
P' (k) = | VP22(0)Pi1(0) P22(0) 0 JP22(0)Pnn (0) (22) 
Pai Pha Pi 
VPnn(0)P110) = /Pnn(0)P22(0) Pnn (0) 
n = n į 
P'(K) = P E 23) 


3. RESULTS AND DISCUSSION 


3.1. Field-test data description 
A micro-electro-mechanical system (MEMS) based IMU was used. The motion pak II is a solid-state 


device cluster in use in instrumentation and control applications to measure linear accelerations and angular 
rates (dead reckoning aiding GPS, robotics, and flight testing etcas seen in Figure 2, the IMU (motion pak II) 
unit was placed on the vehicle's rooftop, with the NovAtel OEM4 GPS receiver [32]. 


3.2. Datasets specification 
The datasets are utilized to put the suggested method to the test. Real dataset consists to outputs IMU 


sensor (motion pak II) and GPS receiver (OEM4). Figure 3 shows the assumed real trajectory obtained by 
combining a better grade IMU (CIMU) with DGPS data. Furthermore, some initial parameters have been used 
to correct a problem of synchronization between the IMU and GPS receiver output data. 


Figure 2. Motion pack II placement on the test Figure 3. True trajectory of the experimental 
vehicle vehicle 


3.3. IMU (motion pak II) properties 
In order to put the proposed approach to the test. GPS data was collected at 1 Hz, whereas inertial 


measurement data was collected at 100 Hz. The data-gathering measurement units were put on top of a land 
vehicle. In Figure 4, the results of the input values fand w, are clearly shown noisy. When GPS/INS fusion 


is not used, the vehicle does not track the reference track over all directions, as shown in Figure 5. 
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Figure 4. IMU measurements along run Figure 5. True trajectory vs GPS measurements 
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3.4. Error state results 

Let’s examine the estimation performance over time, starting with Table 2. Firstly, position error in 
Figure 6, As shown the decay from the initial value along time and the representation of the standard of 
deviation is the magenta dashed line. As seen the geodetic angle errors (ọ, 4) show small changes that oncoming 
to zero, since the model moves only few meters in the LLLN frame. Contrarily, the altitude is scaled in meters 
w.r.t previous samples, such that the error magnitude is much bigger. 

Secondary, velocity error states in Figure 7, Contrarily, the position that is being corrected by the 
observation (GPS measurement) itself, here the errors increase over time and develop in a random walk. v_N 


and v_E show noisy style while v_D succeeds to stabilize, after a period, as it can be clarified our strap down 
model's inexactness. 


Table 2. Accelerometer and gyro-meter properties 


X Y Z 
Bias Factory Accelerometer +125 +125 +125 
Set (mg’, /s) Gyro meter +5.0 +5.0 +5.0 
Scale Factor Accelerometer 6.66 V/g 6.66 V/g 6.66 V/g 
(mg2, °/s) Gyro meter 0.133 V/°/s 0.133 W/°/s 0.133 V/°/s 
Input Axis Alignment Accelerometer 1 1 1 
(°typical) Gyro meter 1 1 1 
ait dp" and ø vs. time — do ðv” and ø vs. time —duy 
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Figure 6. Position error vs time Figure 7. Velocity error vs time 


Now let’s check the euler angles error in Figure 8, it describes the Euler angles error ọ (roll), 8 (pitch) 
and (Sy) that obtained from transformation Matrix R}. As it appears, a small variation occurred on the axis @ 
(roll) and 9 (pitch). Contrarily, a great variation in azimuthal (dy). It's logical because, the variation in the 
planar motions is related in same motion of the orientation of the land vehicle. 


2.5. Degree of observability (DoO) results 

We’ll now show the DoO analysis based on section 2.6, and see if we can determine which states are 
being best estimated (| DoO), and which are most weakly (f DoO). It’s clearly shown in Figure 9, there are 
cambers in starting of the land vehicle in (ọ, à and h) Latitude, longitude and altitude respectively. Afterward, 
continues with many drifts and outages caused by two sensors IMU and GPS 


Euler angles error and o vs. time —d¢ 


DoO(p") vs. time 
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Figure 8. Euler angles error vs time Figure 9. DoO of position error vs time 
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Here in Figure 10, the velocity states DoO, exhibit an acute downhill and after approximately one 
second nullified. This can be explained by the position/velocity IMU coupling within the mode. From 
Figure 11, the vehicle is initialized stationary where noise measurements increase the residual measurement. 
But once motion is starting, the Euler angles’ DoO immediately zero down after, implying that the estimator 
manages to succeed well in the estimating mission, although direct Rj measurement does not exist. 


DoO(v") vs. time DoO(Euler) vs. time 
4r a 
aa « O(vn) 
-e-O(vp) 
-2-O(vp) 


Degree of O 
Degree of O 


0 10 20 30 40 50 60 0 


10 20 30 40 50 60 
Time [sec] 


Time [sec] 


Figure 10. DoO of velocity error vs time Figure 11. DoO of euler angle error vs time 


3.6. Comparison 
3.6.1. GPS measurements, reference and estimate trajectories 

The proposed approach, as illustrated in Figure 12 and Figure 13, gives comparable results for the 
moveable vehicle in all directions. The vehicle is tracking the reference trajectory with nearly no errors in all 
directions, as shown in the following figures, especially after applying the fusion stage over the total running 
duration. Furthermore, the running algorithm did not fail during GPS signal outages, demonstrating the 
suggested approach's ability to recompensate the signal during GPS outages. 


Estimate vs GPS 
Estimate vs Real Trajectory 51.089 T T T 
| Estimate 51.088 > : si mi 
1600 — Real Trajectory 51.087 ‘stimate 
1400 ___ 51.086 I WN 
E 120 “yp 51.085 F 4 
3 = 51.084 
È 800 2 51.083 - 
600 oI. ™ 51.082 + 4 
a = =< = ts 51.081 
o* 0 aE Sas ==, 2 p 51.08 + 
y} e ia ee : 079 L 1 1 L 
East|m a North{m] -114,146 -114.144 -114.142 -114.14 -114.138 -114.136 -114.134 -114.132 -114,13 -114,128 -114.126 
latitude [°] 
Figure 12. Estimate vs true trajectory Figure 13. Estimate vs GPS measurements 


3.6.2. Strapdown (dead reckoning), KF-INS and EKF(INS-GPS) algorithms 

Table 3 shows the drift errors for KF-IMU, EKF (IMU-GPS), and dead reckoning (IMU alone) for 
motion pak II during all six outages, and clearly shows that EKF (IMU-GPS) offers similar results to 
KF/IMU for drift errors when GPS outages occur. Each GPS outage's individual maximum drift errors, as well 
as the mean of the highest drift errors, are presented. The supplied drift errors are calculated by calculating the 
square root of the sum of squared errors in latitude, longitude, and altitude, and thus represent total errors in 
all directions. Dead reckoning, on the other hand, produces findings that are similar to those of the 
EKF(IMU-GPS). Since there is no updated IMU data by GPS for each 1s, this is logical. 
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Table 3. Results for MP field tests 
GPS outages KF/INS (m) Dead reckoning (m) EKF-INS/GPS (m) 


#1 159.4 72.5 104 
#2 212.9 205.8 171 
#3 210.2 174 202 
#4 181.8 240 214 
#5 194.9 275.7 211 
#6 90.49 300 101 
Mean value 179.95 224.16 173.86 


4. CONCLUSION 

In this paper, using noised IMU and global positioning system (GPS) sensors, a realistic approach for 
determining the complete kinematic state of a land-vehicle navigation application based on direct configuration 
approach. On the other hand, the implementation of the concept of DoO with respect to GPS/INS integrated 
systems was conducted and discussed theoretically and experimentally. 

The system's architecture is built on a loosely connected integration method using EKF. For this type 
of system, the EKF is still the standard estimation technique. However, almost all contemporary approaches in 
the literature are based on the filter's indirect setup (namely also error configuration). In general, the results of 
our tests showed, the position and velocity errors converge to zero while the orientation errors remain small 
during the run. There are three possibilities of the reasons that orientation doesn’t converge to zero since could 
be: i) indirect connection between them and the GPS measurements, ii) error from the strap-down algorithm 
(model error). 

Afterward, we examined the filter with several different fusion ratios between GPS and IMU rates and 
saw that as the ratio gets higher the accuracy, but also the calculation’s complexity increases. It is considered 
that the both approaches of GPS/INS integrated systems Based on EKF and the concept of the DoO are 
sufficiently durable to be used in conjunction with low-cost detectors. Finally, future work will focus on 
improving estimation accuracy by adding more dynamic models to the filter and expanding the input sources 
to include other positional sensors such as visual odometry. Furthermore, EKF can be upgraded to its adaptive 
version, which allows the system to perform more efficiently even when there are no GPS signals. 
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